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IN THE UNITED STATES PATENT AND TRADEMARK OFFICE 

Applicants) WINTER et al. 

Serial No. To Be Assigned 

Filed Herewith 

For : DISTANCE SENSOR HAVING A COMPENSATION DEVICE 

FOR A MISALIGNMENT ANGLE IN A VEHICLE 

Art Unit : To Be Assigned 

Examiner To Be Assigned 

Assistant Commissioner 

for Patents 
Washington, D.C. 20231 
Box Patent Application 

PRELIMINARY AMENDMENT AND 
37 C.F.R. S 1.125 SUBSTITUTE SPECIFICATION STATEMENT 

SIR: 

Please amend the above-identified application before examination, as set forth below. 

IN THE SPECIFICATION AND ABSTRACT : 

In accordance with 37 C.F.R. § 1.121(b)(3), a Substitute Specification (including the 
Abstract, but without claims) accompanies this response. It is respectfully requested that the 
Substitute Specification (including Abstract) be entered to replace the Specification of record. 

IN THE CLAIMS : 

On the first page of the claims, first line, change "What is claimed is:" to: 
- What Is Claimed Is :-. 

Please cancel original claims 1 to 11, without prejudice, in the underlying PCT 
Application No. PCT/DE00/03397. 



Please add the following new claims: 



12. (New) A distance sensor for a motor vehicle, comprising: 
a sensor element for performing one of: 

transmitting one of microwaves and light, and 
receiving an echo signal reflected by a target object; 
a control system including an arrangement for, during travel on a straight road, using 
an algorithm to ascertain a misalignment angle of the sensor element with respect to a center 
axis of the motor vehicle from transmitted and received rays, the arrangement correcting a 
continuing angle measurement in accordance with the misalignment angle; and 

an arrangement for compensating for a trajectory for a curvature travel along a curve. 

13. (New) The distance sensor according to claim 12, wherein: 

the arrangement for compensating includes a yaw rate sensor that produces a 
signal capable of correcting the trajectory for the curvature travel. 



14. (New) The distance sensor according to claim 12, wherein: 

the control system determines a quality indicator of the trajectory from 
ascertained misalignment angles of individual trajectories in accordance with an 
adaptive long-term filter. 

15. (New) The distance sensor according to claim 14, wherein: 

the quality indicator is calculated from a correlation value of a regression 
analysis of at least one of the curve, a number of measured points, a trajectory length, 
and an object speed. 



16. (New) The distance sensor according to claim 14, wherein: 

the adaptive long-term filter is a noise-optimized linear filter. 

17. (New) The distance sensor according to claim 16, wherein: 

the noise-optimized linear filter is a Kalman filter. 
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18. (New) The distance sensor according to claim 14, wherein: 

the adaptive long-term filter is a nonlinear filter in which a weighting of 
individual measured values results from a quality appraisal. 

19. (New) The distance sensor according to claim 13, wherein: 

when a positioning of the sensor element occurs outside the center axis of the 
motor vehicle, the control system ascertains the misalignment angle with respect to 
the center axis. 

20. (New) The distance sensor according to claim 19, wherein: 

the control system performs a weighting of the misalignment angle as one of a 
first process involving a function of weighted average values of the yaw rate sensor 
and a second process involving a displacement of the center axis. 

21 . (New) The distance sensor according to claim 20, wherein: 

the weighting occurs on the weighted average values of the first process and 
the second process. 

22. (New) The distance sensor according to claim 20, wherein: 

quality numbers for the misalignment angle are developed from weighting 
factors according to the formula: 

4ipha= Gl(q_traj)*d, 

lphatraj 

+ G2(q_ob,>d a 

lphaobj • 

where d^ ipha is a currently valid misalignment angle from the center axis, Gl (q_traj) 
and G2(q obj) are weighted average values from values of one of the yaw rate sensor 
and an average displacement, and d^ iphiJai and da lpha obj are associated angles. 

23. (New) A speed regulator, comprising: 

a distance sensor for a motor vehicle, the distance sensor including: 
a sensor element for performing one of: 
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transmitting one of microwaves and light, and 
receiving an echo signal reflected by a target object; 
a control system including an arrangement for, during travel on a straight road, 
using an algorithm to ascertain a misalignment angle of the sensor element with respect to a 
center axis of the motor vehicle from transmitted and received rays, the arrangement 
correcting a continuing angle measurement in accordance with the misalignment angle; 
and 

an arrangement for compensating for a trajectory for a curvature travel along a 
curve, wherein: 

the sensor element is mounted on at least one of a front and a rear area of the 
motor vehicle. 

Remarks 

This Preliminary Amendment cancels original claims 1 to 11, without 
prejudice, in the underlying PCT Application No. PCT/DE00/03397. The Preliminary 
Amendment also adds new claims 12-23. The new claims conform the claims to U.S. Patent 
and Trademark Office rules and do not add new matter to the application. 

In accordance with 37 C.F.R. § 1.121(b)(3), the Substitute Specification 
(including the Abstract, but without the claims) contains no new matter. The amendments 
reflected in the Substitute Specification (including Abstract) are to conform the Specification 
and Abstract to U.S. Patent and Trademark Office rules or to correct informalities. As 
required by 37 C.F.R. § 1.121(b)(3)(iii) and § 1.125(b)(2), a Marked Up Version Of The 
Substitute Specification comparing the Specification of record and the Substitute 
Specification also accompanies this Preliminary Amendment. Approval and entry of the 
Substitute Specification (including Abstract) are respectfully requested. 

The underlying PCT Application No. PCT/DE00/03397 includes an 
International Search Report, dated March 16, 2001, a copy of which is submitted herewith. 
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Applicants assert that the subject matter of the present application is new, 
non-obvious, and useful. Prompt consideration and allowance of the application are 
respectfully requested. 

Respectfully Submitted, 



KENYON & KENYON 

bf^h/ fly- %Oh^^%^ 



Richard L. Mayer 
(Reg. No. 22,490) 

One Broadway 

New York, NY 10004 

(212) 425-7200 
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DISTANCE SENSOR HAVING A COMPENSATION DEVICE FOR A MISALIGNMENT 
ANGLE IN A VEHICLE. 



Field Of The Invention 

The present invention relates to a distance sensor for a vehicle having a sensor for 
transmitting microwaves or light, or for receiving an echo signal reflected by a target object. 

Background Information 

In the case of speed regulators having a distance sensor (Adaptive Cruise Control, ACC) 
adapting travel speed of a motor vehicle to slower vehicles traveling ahead, when these are 
detected by the distance sensor, is already known. However, the distance sensor has a limited 
detection range, and thus can only detect such vehicles as are located in the prospective 
course range of the following vehicle. A misalignment of this detection range, which can 
occur either during installation on the vehicle or during operation, has the effect, however, 
that the longitudinal axis of the distance sensor relatively to the nominal alignment (center 
line of the vehicle) has a systematic angle of deviation. This can have the result that this 
misalignment, for example, leads to a faulty lane assignment of a detected radar object on the 
path of motion of the motor vehicle (trajectory), that is, to a vehicle being followed or coming 
in the opposite direction, and that thereby an undesired reaction of the speed regulator can 
take place. 

A compensating device is known, for example, from German Published Patent Application 
No. 197 46 524, for compensating for the installation tolerances of a distance sensor in a 
vehicle, in which the installation tolerances of a distance sensor are compensated. Using an 
electronic evaluation device, current object distances and a current object angle are measured 
during travel, for detected objects relatively to the vehicle axis. In this connection, the 

<tL£-44^o^t no 
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misalignment angle to the current target object is determined by forming an average value of 
many measurements. It is true, though, that this average value formation functions 
satisfactorily only if the vehicle can follow the target object, a second vehicle traveling ahead, 
on a sufficiently long straight path, so that frequent measurements to the target object can be 
5 carried out. In the case of curves in the road or, also, uphill and down dale travel with 
changing angle of altitude, this method fails. 

On the other hand, in the case of the device for calculating and correcting a misalignment 
angle for a distance sensor according to European Published Patent Application No. 0 782 
1 0 008 the angle of deviation from the center line is described, using a regression method. To do 
I this, the angle is measured in each measurement cycle as a function of the distance from 
; moving, or better still, from fixed radar objects. In particular in dense traffic, however, there 
are not enough suitable objects within sight range of the sensor, so that not enough measured 
values are available. Thus, each method has the disadvantage that the availability of measured 
15 -„ values depends on the travel situation or the traffic situation, as the case may be. 

" Summary Of The Invention 

~ By comparison, the distance sensor or the speed regulator according to the present invention 
20 has the advantage that the reliability of the misalignment identification increases by the 
combination of a plurality of methods for determing a misalignment angle. 

A particular advantage as compared to the known related art is considered also to be that the 
measurements for the misalignment angle can be carried out, not only on a straight travel 
25 path, but also along a curve. More measured values result from this, which, in particular, also 
favor the formation of the average value. 

It is especially advantageous that a yaw rate sensor is provided as a further instrument, whose 
signals can be used for correcting trajectory curves. Since the yaw rate sensor detects the 
30 rotary motion of the vehicle about the vertical axis, it thereby also detects, in consideration of 
the driving speed, the bend in the travel path, or the curve, so that, from these data, 
appropriate angle calculations with respect to a vehicle driving ahead, which has been 
detected by the sensor, can be carried out The bend of a trajectory, in this connection, is 
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looked upon as being the reciprocal value of the radius of the path, (in English: the 
curvature). 

With the aid of adaptive long-term filtering, quality indicators of the trajectory are ascertained 
from the ascertained misalignment angles of individual trajectories. With the aid of the 
quality indicators of the trajectory, reliability of the angle measurement is advantageously 
improved. In this case, for example, the determination of the quality indicators is made from 
the correlation value of a regression analysis of the curvature, the number of measured values, 
the length of the trajectory and/or the speed of the object. Since these parameters are 
relatively simple to measure, this also makes possible a simple calculation of the quality 
indicator. 

For the application of adaptive long-term filtering of the ascertained misalignment angle from 
individual trajectories, for example, a noise-optimized, linear, adaptive filter (e.g. a Kalman 
filter) is suitable, or a nonlinear filter in which the weighting of the individual measured 
values from the quality valuation is based on the quality indicators of the trajectory. 

A nonlinear filter can also be used as a suitable adaptive long-term filter, in which the 
weighting of the individual measured values is done from the quality appraisal. 

It is regarded as a special advantage that, with a positioning of the sensor outside the center 
line of the motor vehicle, the control system ascertains the misalignment angle with respect to 
the center line of the motor vehicle. That also causes the lateral angle arising from the center 
displacement of the sensor to be compensated for. 

It is also favorable that the ascertainment of the misalignment angle is weighted either as a 
function of the weighted average values of the yaw rate sensor or of the displacement from 
the center line. This yields an improvement in the signal quality, which improves the 
robustness of the method for determining the misalignment angle, depending on the 
availability of the individual systems, since almost always at least one of the two methods 
receives suitable input data. Thereby one method advantageously compensates for the 
weaknesses of the other method. 
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By weighting the averaged mean values of the two individual methods, one obtains an 
improved signal quality. 

Brief Description Of The Drawings 

Figure 1 shows a first diagram with angle representations of ray paths. 
Figure 2 shows a block diagram of a distance sensor. 
Figure 3 shows a second diagram. 

Detailed Description 

Figure 1 shows two motor vehicles 5, 6 which are traveling along on a road one behind the 
other at a distance d, the assumption being that motor vehicle 5 is behind motor vehicle 6. 
Furthermore, for reasons of clarity, only the middle rays of a sensor 2 are illustrated, not the 
entire radiation in the radiation range. It is also assumed in the exemplary embodiment that, 
in a first embodiment variant, a sensor 2 is mounted centrically on the front face of motor 
vehicle 5. It is aligned in such a way that its middle ray detects the rear end of motor vehicle 
6 driving ahead. On account of an assumed misalignment, the transmitted ray does not hit the 
rear end along the center line of motor vehicle 5, but rather displaced by an average angle 
alpha_sensor. For the sake of completeness, let it be mentioned that this reflected ray is 
received by a corresponding receiving device of sensor 2 and evaluated. Such an evaluation 
method is known, for example, from German Published Patent Application No. 197 46 524. 
In the exemplary embodiment according to the present invention, the sensor is not positioned 
centrically but laterally displaced by a distance y ndar . With this sensor 2, now, the central ray 
b hits the projected center line of motor vehicle 5 at the rear end of target object 6 at an angle 
alpha vehicle. From this positioning displaced from the center by the distance y radar , and the 
distance d to vehicle 6 driving ahead, an angle can now be determined according to the 
equation 

alpha_vehicle = alpha_sensor + y radar /d. 



This angle alpha_vehicle is ascertained by repeated measurements during the trip and suitable 
long-term filtering. Using this systematic deviation, the angle measurement of sensor 2 can be 
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corrected. 



Carried out principally on a straight stretch of road, this method of compensating the 
misalignment angle by averaging the current target object angle over a plurality of 
measurements is less applicable in curves of the road, since there, the target "vehicle 6, 
driving ahead" is constantly changing the relative vehicle position with respect to sensor 2, 
because of the radius of curvature. To compensate for the error caused by the radius of 
curvature of the road, a yaw rate sensor 3 is provided on motor vehicle 5 to detect the change 
of direction of motor vehicle 5 about its vertical axis. Using the normalized signal from yaw 
rate sensor 3 and the angle alphavehicle, the result is an average deviation of the 
curvature-corrected angle according to the formula, 

daipha_obj ec t = average value(alpha_vehicle - 

d 2 *yaw rate/(2* vehicle speed)), 

where d^ _ object corresponds to the corrected angle and the yaw rate corresponds to the signal 
of yaw rate sensor 3. 

The averaging is to be carried out by a long-term low-pass filter. Furthermore, depending on 
the frequency of the averaging, for the magnitude (^.object a quality value q object can be given 
for the reliability of the angle. Since a curve 1 1 in a road can be set into a plurality of 
trajectories, there is a further possibility, when determining the misalignment angle, of 
applying a regression method known per se, as described, for instance, in European Published 
Patent Application No. 0 782 008. According to the present invention, as shown in Figure 3, 
in dependence on the distance to a moving, or better still, standing target object 10, as, for 
example, a crash barrier part or a post, angles wl or w2 respectively, depending on position A 
or B of vehicle 5, are measured in curve 1 1 . From the distance d(ti) or d(tj) at point in time ti 
(position A) or tj (position B) of vehicle 5, for instance, to standing target 10, a lateral 
displacement y(ti) or y(tj) can be calculated by simple trigonometrical conversion. In contrast 
to the known method, this advantageously yields additional measuring points within sensor 2, 
for travel in a curve. It is therefore proposed by the present invention also to combine this 
method of regression analysis of trajectories with yaw rate signal 3, in order to compensate 
for the trajectory curvatures. The measured values thus obtained are averaged by adaptive 
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long-term filtering of the ascertained misalignment angles of single trajectories. A 
noise-optimized, linear adaptive filter, for example a Kalman filter, can be used as the 
suitable filter. Alternatively, a nonlinear filter can also be used, in which the weighting of the 
individual measured value is founded on the quality assessment, which is based on quality 
indicators of the trajectory. The quality indicators are formed, for instance, from the 
correlation value of the regression analysis, from the curvature, number of measured points, 
trajectory length and object speed. 

As a result, a sliding long-term filtered misalignment angle d^ lpka tIaj or a quality value q_traj is 
ascertained for the reliability of the angle, or rather is updated with each analyzed trajectory. 

Since this second method also does not always yield suitable trajectories, particularly in 
heavy columnar traffic, in an alternative solution both approaches are advantageously linked 
to each other. Depending on the reliability of the individual methods, the weightings of the 
approaches can be varied statically or dynamically. The linking of the two approaches takes 
place via a weighted average value of both individual methods. The weights are determined 
from the quality numbers: 

4ipha = Gl (q_traj)*d alpha traj + G2(q_obj)*d alpJia _ obj . 

where Gl(q_traj) and G2(q_obj) are the weights from the quality numbers. In this respect, 
Q traj and q_obj form the quality numbers Qi. 

By the introduction of quality numbers Qi for each method, with a decrease in Qi in case no 
input variable is available for the method in the current cycle, and an increase in case input 
variables are available, a simple possibility of selection was found as to which of the two 
methods is delivering, at the moment, the more reliable statement concerning the current 
angle measurement. Besides the improvement of the signal quality by the combination, the 
robustness of the methods increases also, since almost always at least one of the two methods 
contains suitable input data, that means, that one method compensates for the weaknesses of 
the other method. 



Figure 2 shows a block diagram of distance sensor 10, in which control system 1 is connected 
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to sensor 2 and yaw rate sensor 3. There is also provided a compensation device for angle 
measurement 4, in which, among other things, the calculation of the angles, among other 
things, is carried out. The above-named calculations are preferably made with a program that 
is run by the microcomputer of control system 1 . 
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Abstract Of The Disclosure 
A distance sensor having a sensor for a motor vehicle in which an arrangement is provided by 
which gnment angles and trajectory curvatures can be compensated for during travel not only 
on a straight road but also along curves. In a sensor mounted displaced from the center line of 
the vehicle, an angle (alphasensor) is measured which cuts the projected center line of the 
motor vehicle at the target object, a vehicle driving ahead. By the additional use of a yaw rate 
sensor, curve curvatures of the road are also compensated for, so that angle and distance 
measurement can also be made along curves. 
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DISTANCE SENSOR HAVING A COMPENSATION DEVICE FOR A MISALIGNMENT 
ANGLE IN A VEHICLE. 



Field Of The Invention 
The present inven^^ 

transmitting microwaves or light. qr for reeeiyk^ ffl.echQ signal reflected by a target ob ject. 

5- 

Background Information 

[The present invention starts from a distance sensor for a vehicle having a sensor for 
transmitting microwaves or light, or for receiving an echo signal reflected by a target-object, 

1 0= according to the species of the main claim, J In the case of speed regulators having a distance 
sensor (Adaptive Cruise Control, ACC) adapting travel speed of a motor vehicle to slower 
vehicles traveling ahead, when these are detected by the distance sensor, is already known. 
However, the distance sensor has a limited detection range, and thus can only detect such 
vehicles as are located in the prospective course range of the following vehicle. A 

1 5 misalignment of this detection range, which can occur either during installation on the vehicle 
or during operation, has the effect, however, that the longitudinal axis of the distance sensor 
relatively to the nominal alignment (center line of the vehicle) has a systematic angle of 
deviation. This can have the result that this misalignment, for example, leads to a faulty lane 
assignment of a detected radar object on the path of motion of the motor vehicle (trajectory), 

20 that is, to a vehicle being followed or coming in the opposite direction, and that thereby an 
undesired reaction of the speed regulator can take place. 

A compensating device is known, for example, from German Published Patent Application 
No. 197 46 524 [A1], for compensating for the installation tolerances of a distance sensor in a 
25 vehicle, in which the installation tolerances of a distance sensor are compensated. Using an 
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electronic evaluation device, current object distances and a current object angle are measured 
during travel, for detected objects relatively to the vehicle axis. In this connection, the 
misalignment angle to the current target object is determined by forming an average value of 
many measurements. It is true, though, that this average value formation functions 
satisfactorily only if the vehicle can follow the target object, a second vehicle traveling ahead, 
on a sufficiently long straight path, so that frequent measurements to the target object can be 
carried out. In the case of curves in the road or, also, uphill and down dale travel with 
changing angle of altitude, this method fails. 

On the other hand, in the case of the device for calculating and correcting a misalignment 
angle for a distance sensor according to European Published Patent Application No. 0 782 
008 [A2J the angle of deviation from the center line is described, using a regression method. 
To do this, the angle is measured in each measurement cycle as a function of the distance 
from moving, or better still, from fixed radar objects. In particular in dense traffic, however, 
there are not enough suitable objects within sight range of the sensor, so that not enough 
measured values are available. Thus, each method has the disadvantage that the availability of 
measured values depends on the travel situation or the traffic situation, as the case may be. 

Summary [of the] Of The Invention 

By comparison, the distance sensor or the : spebd #g]aSatQr according to the present invention 
[or the speed regulator according to independent Claims 1 and 11, respectively J has the 
advantage that the reliability of the misalignment identification increases by the combination 
of a plurality of methods for determing a misalignment angle. 

A particular advantage as compared to the known related art is considered also to be that the 
measurements for the misalignment angle can be carried out, not only on a straight travel 
path, but also along a curve. More measured values result from this, which, in particular, also 
favor the formation of the average value. 

[As a result of the measures specified in ffie dependent claims, advantageous further 

i efmements and improvements of the method indicated in the main claim are possible.} It is 

especially advantageous that a yaw rate sensor is provided as a further instrument, whose 
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signals can be used for correcting trajectory curves. Since the yaw rate sensor detects the 
rotary motion of the vehicle about the vertical axis, it thereby also detects, in consideration of 
the driving speed, the bend in the travel path, or the curve, so that, from these data, 
appropriate angle calculations with respect to a vehicle driving ahead, which has been 
5 detected by the sensor, can be carried out The bend of a trajectory, in this connection, is 
looked upon as being the reciprocal value of the radius of the path, (in English: the 
curvature). 

With the aid of adaptive long-term filtering, quality indicators of the trajectory are ascertained 
10 from the ascertained misalignment angles of individual trajectories. With the aid of the 

quality indicators of the trajectory, reliability of the angle measurement is advantageously 
: improved. In this case, for example, the determination of the quality indicators is made from 

the correlation value of a regression analysis of the curvature, the number of measured values, 

the length of the trajectory and/or the speed of the object. Since these parameters are 
1 5 relatively simple to measure, this also makes possible a simple calculation of the quality 

indicator. 

For the application of adaptive long-term filtering of the ascertained misalignment angle from 
Z individual trajectories, for example, a noise-optimized, linear, adaptive filter (e.g. a Kalman 
20 filter) is suitable, or a nonlinear filter in which the weighting of the individual measured 
values from the quality valuation is based on the quality indicators of the trajectory. 

A nonlinear filter can also be used as a suitable adaptive long-term filter, in which the 
weighting of the individual measured values is done from the quality appraisal. 

25 

It is regarded as a special advantage that, with a positioning of the sensor outside the center 
line of the motor vehicle, the control system ascertains the misalignment angle with respect to 
the center line of the motor vehicle. That also causes the lateral angle arising from the center 
displacement of the sensor to be compensated for. 

30 

It is also favorable that the ascertainment of the misalignment angle is weighted either as a 
function of the weighted average values of the yaw rate sensor or of the displacement from 
the center line. This yields an improvement in the signal quality, which improves the 
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robustness of the method for determining the misalignment angle, depending on the 
availability of the individual systems, since almost always at least one of the two methods 
receives suitable input data. Thereby one method advantageously compensates for the 
weaknesses of the other method. 

By weighting the averaged mean values of the two individual methods, one obtains an 
improved signal quality. 

Brief Description Of The Drawings [of the Drawing 

An exemplary embodiment of the present invention is represented in the drawings and 
explained detail in the following description.] 

Figure 1 shows a first diagram with angle representations of ray paths [j. 3 
Figure 2 shows a block diagram of a distance sensor [and]^ 
Figure 3 shows a second diagram. 

Detailed Description (of the Exemplary Embodiment] 

Figure 1 shows two motor vehicles 5, 6 which are traveling along on a road one behind the 
other at a distance d, the assumption being that motor vehicle 5 is behind motor vehicle 6. 
Furthermore, for reasons of clarity, only the middle rays of a sensor 2 are illustrated, not the 
entire radiation in the radiation range. It is also assumed in the exemplary embodiment that, 
in a first embodiment variant, a sensor 2 is mounted centrically on the front face of motor 
vehicle 5. It is aligned in such a way that its middle ray detects the rear end of motor vehicle 
6 driving ahead. On account of an assumed misalignment, the transmitted ray does not hit the 
rear end along the center line of motor vehicle 5, but rather displaced by an average angle 
alpha_sensor. For the sake of completeness, let it be mentioned that this reflected ray is 
received by a corresponding receiving device of sensor 2 and evaluated. Such an evaluation 
method is known, for example, from German Published Patent Application No. 197 46 524 



positioned centrically but laterally displaced by a distance y radar . With this sensor 2, now, the 
central ray b hits the projected center line of motor vehicle 5 at the rear end of target object 6 



[Al]. In the exemplary embodiment according to the present invention, the sensor is not 
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at an angle alphavehicle. From this positioning displaced from the center by the distance 
y radar , and the distance d to vehicle 6 driving ahead, an angle can now be determined according 
to the equation 

5 alpha_vehicle = alpha_sensor + y mia Jd. 

This angle alpha vehicle is ascertained by repeated measurements during the trip and suitable 
long-term filtering. Using this systematic deviation, the angle measurement of sensor 2 can be 
corrected. 

10 

Carried out principally on a straight stretch of road, this method of compensating the 
misalignment angle by averaging the current target object angle over a plurality of 
I measurements is less applicable in curves of the road, since there, the target "vehicle 6, 

driving ahead" is constantly changing the relative vehicle position with respect to sensor 2, 
1 5 because of the radius of curvature. To compensate for the error caused by the radius of 

curvature of the road, a yaw rate sensor 3 is provided on motor vehicle 5 to detect the change 
of direction of motor vehicle 5 about its vertical axis. Using the normalized signal from yaw 
rate sensor 3 and the angle alpha_vehicle, the result is an average deviation of the 
curvature-corrected angle according to the formula, 

20 

dai P ha_object = average value(alpha_vehicle - 

d 2 *yaw rate/(2* vehicle speed)), 

where d^ object corresponds to the corrected angle and the yaw rate corresponds to the signal 
25 of yaw rate sens or 3 . 

The averaging is to be carried out by a long-term low-pass filter. Furthermore, depending on 
the frequency of the averaging, for the magnitude d^^ otject a quality value q 0 bj e ct can be given 
for the reliability of the angle. Since a curve 1 1 in a road can be set into a plurality of 
30 trajectories, there is a further possibility, when determining the misalignment angle, of 

applying a regression method known per se, as described, for instance, in European Published 
Patent Application No. 0 782 008 [A2]. According to the present invention, as shown in 
Figure 3, in dependence on the distance to a moving, or better still, standing target object 10, 
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as, for example, a crash barrier part or a post, angles wl or w2 respectively, depending on 
position A or B of vehicle 5, are measured in curve 1 1 . From the distance d(ti) or d(tj) at 
point in time ti (position A) or tj (position B) of vehicle 5, for instance, to standing target 10, 
a lateral displacement y(ti) or y(tj) can be calculated by simple trigonometrical conversion. In 
5 contrast to the known method, this advantageously yields additional measuring points within 
sensor 2, for travel in a curve. It is therefore proposed by the present invention also to 
combine this method of regression analysis of trajectories with yaw rate signal 3, in order to 
compensate for the trajectory curvatures. The measured values thus obtained are averaged by 
adaptive long-term filtering of the ascertained misalignment angles of single trajectories. A 

10 noise-optimized, linear adaptive filter, for example a Kalman filter, can be used as the 

suitable filter. Alternatively, a nonlinear filter can also be used, in which the weighting of the 
== individual measured value is founded on the quality assessment, which is based on quality 
I indicators of the trajectory. The quality indicators are formed, for instance, from the 

correlation value of the regression analysis, from the curvature, number of measured points, 

15". traj ectory length and obj ect speed. 

As a result, a sliding long-term filtered misalignment angle d^ vha _ traj or a quality value q_traj is 
ascertained for the reliability of the angle, or rather is updated with each analyzed trajectory. 

20 Since this second method also does not always yield suitable trajectories, particularly in 

heavy columnar traffic, in an alternative solution both approaches are advantageously linked 
to each other. Depending on the reliability of the individual methods, the weightings of the 
approaches can be varied statically or dynamically. The linking of the two approaches takes 
place via a weighted average value of both individual methods. The weights are determined 

25 from the quality numbers: 

daipha = Gl (q_traj)*d alpha taj + G2(q_obj)*d alpha obj . 

where Gl(q_traj) and G2(q_obj) are the weights from the quality numbers. In this respect, 
30 Q_traj and q_obj form the quality numbers Qi. 



By the introduction of quality numbers Qi for each method, with a decrease in Qi in case no 
input variable is available for the method in the current cycle, and an increase in case input 
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variables are available, a simple possibility of selection was found as to which of the two 
methods is delivering, at the moment, the more reliable statement concerning the current 
angle measurement. Besides the improvement of the signal quality by the combination, the 
robustness of the methods increases also, since almost always at least one of the two methods 
contains suitable input data, that means, that one method compensates for the weaknesses of 
the other method. 

Figure 2 shows a block diagram of distance sensor 10, in which control system 1 is connected 
to sensor 2 and yaw rate sensor 3. There is also provided a compensation device for angle 
measurement 4, in which, among other things, the calculation of the angles, among other 
things, is carried out. The above-named calculations are preferably made with a program that 
is run by the microcomputer of control system 1. 
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Abstract 



The present invention proposes a] A distance sensor having a sensor for a motor vehicle in 
which [means are] an arrangement is provided by which [misalignment] gnment angles and 
trajectory curvatures can be compensated for during travel not only on a straight road but also 
along curves. In a sensor [(2)} mounted displaced from the center line of the vehicle, an angle 
(alpha_sensor) is measured which cuts the projected center line of the motor vehicle [(5)] at 
the target object, a vehicle [{6)] driving ahead. By the additional use of a yaw rate sensor[(3)J, 
curve curvatures of the road are also compensated for, so that angle and distance 
measurement can also be made along curves. 



[(Figure 1)] 
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DISTANCE SENSOR HAVING A COMPENSATION DEVICE FOR A MISALIGNMENT 
ANGLE IN A VEHICLE. 



Background Information 

The present invention starts from a distance sensor for a vehicle having a sensor for 
transmitting microwaves or light, or for receiving an echo signal reflected by a target object, 
according to the species of the main claim. In the case of speed regulators having a distance 
sensor (Adaptive Cruise Control, ACC) adapting travel speed of a motor vehicle to slower 
vehicles traveling ahead, when these are detected by the distance sensor, is already known. 
However, the distance sensor has a limited detection range, and thus can only detect such 
vehicles as are located in the prospective course range of the following vehicle. A 
misalignment of this detection range, which can occur either during installation on the vehicle 
or during operation, has the effect, however, that the longitudinal axis of the distance sensor 
relatively to the nominal alignment (center line of the vehicle) has a systematic angle of 
deviation. This can have the result that this misalignment, for example, leads to a faulty lane 
assignment of a detected radar object on the path of motion of the motor vehicle (trajectory), 
that is, to a vehicle being followed or coming in the opposite direction, and that thereby an 
undesired reaction of the speed regulator can take place. 

A compensating device is known, for example, from German Patent No. 197 46 524 Al, for 
compensating for the installation tolerances of a distance sensor in a vehicle, in which the 
installation tolerances of a distance sensor are compensated. Using an electronic evaluation 
device, current object distances and a current object angle are measured during travel, for 
detected objects relatively to the vehicle axis. In this connection, the misalignment angle to 
the current target object is determined by forming an average value of many measurements. It 
is true, though, that this average value formation functions satisfactorily only if the vehicle 
can follow the target object, a second vehicle traveling ahead, on a sufficiently long straight 
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path, so that frequent measurements to the target object can be carried out. In the case of 
curves in the road or, also, uphill and down dale travel with changing angle of altitude, this 
method fails. 

5 On the other hand, in the case of the device for calculating and correcting a misalignment 
angle for a distance sensor according to European Patent No. 0 782 008 A2 the angle of 
deviation from the center line is described, using a regression method. To do this, the angle 
is measured in each measurement cycle as a function of the distance from moving, or better 
still, from fixed radar objects. In particular in dense traffic, however, there are not enough 
10 suitable objects within sight range of the sensor, so that not enough measured values are 
available. Thus, each method has the disadvantage that the availability of measured values 
-Z depends on the travel situation or the traffic situation, as the case may be. 

Summary of the Invention 

15 ■; 

By comparison, the distance sensor according to the present invention or the speed regulator 
according to independent Claims 1 and 11, respectively, has the advantage that the reliability 
of the misalignment identification increases by the combination of a plurality of methods for 
determing a misalignment angle. 

20 I 

A particular advantage as compared to the known related art is considered also to be that the 
measurements for the misalignment angle can be carried out, not only on a straight travel 
path, but also along a curve. More measured values result from this, which, in particular, also 
favor the formation of the average value. 

25 

As a result of the measures specified in the dependent claims, advantageous further 
refinements and improvements of the method indicated in the main claim are possible. It is 
especially advantageous that a yaw rate sensor is provided as a further instrument, whose 
signals can be used for correcting trajectory curves. Since the yaw rate sensor detects the 
30 rotary motion of the vehicle about the vertical axis, it thereby also detects, in consideration of 
the driving speed, the bend in the travel path, or the curve, so that, from these data, 
appropriate angle calculations with respect to a vehicle driving ahead, which has been 
detected by the sensor, can be carried out The bend of a trajectory, in this connection, is 
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looked upon as being the reciprocal value of the radius of the path, (in English: the 
curvature). 

With the aid of adaptive long-term filtering, quality indicators of the trajectory are ascertained 
from the ascertained misalignment angles of individual trajectories. With the aid of the 
quality indicators of the trajectory, reliability of the angle measurement is advantageously 
improved. In this case, for example, the determination of the quality indicators is made from 
the correlation value of a regression analysis of the curvature, the number of measured values, 
the length of the trajectory and/or the speed of the object. Since these parameters are 
relatively simple to measure, this also makes possible a simple calculation of the quality 
indicator. 

For the application of adaptive long-term filtering of the ascertained misalignment angle from 
individual trajectories, for example, a noise-optimized, linear, adaptive filter (e.g. a Kalman 
filter) is suitable, or a nonlinear filter in which the weighting of the individual measured 
values from the quality valuation is based on the quality indicators of the trajectory. 

A nonlinear filter can also be used as a suitable adaptive long-term filter, in which the 
weighting of the individual measured values is done from the quality appraisal. 

It is regarded as a special advantage that, with a positioning of the sensor outside the center 
line of the motor vehicle, the control system ascertains the misalignment angle with respect to 
the center line of the motor vehicle. That also causes the lateral angle arising from the center 
displacement of the sensor to be compensated for. 

It is also favorable that the ascertainment of the misalignment angle is weighted either as a 
function of the weighted average values of the yaw rate sensor or of the displacement from 
the center line. This yields an improvement in the signal quality, which improves the 
robustness of the method for determining the misalignment angle, depending on the 
availability of the individual systems, since almost always at least one of the two methods 
receives suitable input data. Thereby one method advantageously compensates for the 
weaknesses of the other method. 
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By weighting the averaged mean values of the two individual methods, one obtains an 
improved signal quality. 

Brief Description of the Drawing 

5 

An exemplary embodiment of the present invention is represented in the drawings and 
explained in detail in the following description. 

Figure 1 shows a first diagram with angle representations of ray paths, Figure 2 shows a 
1 0 block diagram of a distance sensor and Figure 3 shows a second diagram. 

~- Description of the Exemplary Embodiment 

} Figure 1 shows two motor vehicles 5, 6 which are traveling along on a road one behind the 

1 5 ' other at a distance d, the assumption being that motor vehicle 5 is behind motor vehicle 6. 

Furthermore, for reasons of clarity, only the middle rays of a sensor 2 are illustrated, not the 
entire radiation in the radiation range. It is also assumed in the exemplary embodiment that, 
in a first embodiment variant, a sensor 2 is mounted centrically on the front face of motor 
vehicle 5. It is aligned in such a way that its middle ray detects the rear end of motor vehicle 

20 6 driving ahead. On account of an assumed misalignment, the transmitted ray does not hit the 
rear end along the center line of motor vehicle 5, but rather displaced by an average angle 
alpha_sensor. For the sake of completeness, let it be mentioned that this reflected ray is 
received by a corresponding receiving device of sensor 2 and evaluated. Such an evaluation 
method is known, for example, from German Patent No. 197 46 524 Al. In the exemplary 

25 embodiment according to the present invention, the sensor is not positioned centrically but 
laterally displaced by a distance y radar . With this sensor 2, now, the central ray b hits the 
projected center line of motor vehicle 5 at the rear end of target object 6 at an angle 
alpha_vehicle. From this positioning displaced from the center by the distance y radar , and the 
distance d to vehicle 6 driving ahead, an angle can now be determined according to the 

30 equation 

alpha_vehicle = alpha_sensor + y^/d. 
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This angle alphavehicle is ascertained by repeated measurements during the trip and suitable 
long-term filtering. Using this systematic deviation, the angle measurement of sensor 2 can be 
corrected. 

Carried out principally on a straight stretch of road, this method of compensating the 
misalignment angle by averaging the current target object angle over a plurality of 
measurements is less applicable in curves of the road, since there, the target "vehicle 6, 
driving ahead" is constantly changing the relative vehicle position with respect to sensor 2, 
because of the radius of curvature. To compensate for the error caused by the radius of 
curvature of the road, a yaw rate sensor 3 is provided on motor vehicle 5 to detect the change 
of direction of motor vehicle 5 about its vertical axis. Using the normalized signal from yaw 
rate sensor 3 and the angle alpha_vehicle, the result is an average deviation of the 
curvature-corrected angle according to the formula, 

daipha_object = average value(alpha_vehicle - 

d 2 *yaw rate/(2* vehicle speed)), 

where da^hao,,^ corresponds to the corrected angle and the yaw rate corresponds to the signal 
of yaw rate sensor 3. 

The averaging is to be carried out by a long-term low-pass filter. Furthermore, depending on 
the frequency of the averaging, for the magnitude d^ _ object a quality value q object can be given 
for the reliability of the angle. Since a curve 1 1 in a road can be set into a plurality of 
trajectories, there is a further possibility, when determining the misalignment angle, of 
applying a regression method known per se, as described, for instance, in European Patent 
No. 0 782 008 A2. According to the present invention, as shown in Figure 3, in dependence 
on the distance to a moving, or better still, standing target object 10, as, for example, a crash 
barrier part or a post, angles wl or w2 respectively, depending on position A or B of vehicle 
5, are measured in curve 1 1 . From the distance d(ti) or d(tj) at point in time ti (position A) or 
tj (position B) of vehicle 5, for instance, to standing target 1 0, a lateral displacement y(ti) or 
y(tj) can be calculated by simple trigonometrical conversion. In contrast to the known 
method, this advantageously yields additional measuring points within sensor 2, for travel in 
a curve. It is therefore proposed by the present invention also to combine this method of 

NY01 387531 v 1 5 



regression analysis of trajectories with yaw rate signal 3, in order to compensate for the 
trajectory curvatures. The measured values thus obtained are averaged by adaptive long-term 
filtering of the ascertained misalignment angles of single trajectories. A noise-optimized, 
linear adaptive filter, for example a Kalman filter, can be used as the suitable filter. 
5 Alternatively, a nonlinear filter can also be used, in which the weighting of the individual 

measured value is founded on the quality assessment, which is based on quality indicators of 
the trajectory. The quality indicators are formed, for instance, from the correlation value of 
the regression analysis, from the curvature, number of measured points, trajectory length and 
object speed. 

10 

As a result, a sliding long-term filtered misalignment angle d^ _ traj or a quality value qjxaj is 
ascertained for the reliability of the angle, or rather is updated with each analyzed trajectory. 

Z Since this second method also does not always yield suitable trajectories, particularly in 
1 5 heavy columnar traffic, in an alternative solution both approaches are advantageously linked 
to each other. Depending on the reliability of the individual methods, the weightings of the 
approaches can be varied statically or dynamically. The linking of the two approaches takes 
place via a weighted average value of both individual methods. The weights are determined 
from the quality numbers: 

20 

daipha = Gl (q_traj)*d alpJia traj + G2(q_obj)*d alplla obj . 

where Gl(q_traj) and G2(q_obj) are the weights from the quality numbers. In this respect, 
Q_traj and q_obj form the quality numbers Qi. 

25 

By the introduction of quality numbers Qi for each method, with a decrease in Qi in case no 
input variable is available for the method in the current cycle, and an increase in case input 
variables are available, a simple possibility of selection was found as to which of the two 
methods is delivering, at the moment, the more reliable statement concerning the current 
30 angle measurement. Besides the improvement of the signal quality by the combination, the 

robustness of the methods increases also, since almost always at least one of the two methods 
contains suitable input data, that means, that one method compensates for the weaknesses of 
the other method. 
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Figure 2 shows a block diagram of distance sensor 10, in which control system 1 is connected 
to sensor 2 and yaw rate sensor 3. There is also provided a compensation device for angle 
measurement 4, in which, among other things, the calculation of the angles, among other 
things, is carried out. The above-named calculations are preferably made with a program that 
is run by the microcomputer of control system 1 . 
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What is claimed is: 

1 . A distance sensor for a motor vehicle, having a sensor (2) for transmitting microwaves 
or light, or for receiving an echo signal reflected by a target object, and having a 
control system (1) which has the means, during travel on a straight road, for 
ascertaining a misalignment angle (alpha_sensor) of the sensor (2) with respect to the 
center axis (M) of the motor vehicle (5) from the transmitted and received rays, using 
an algorithm, and for using it to correct the continuing angle measurement, 
wherein further means (3) are provided by which compensation for trajectory 
curvatures can be made during travel along a curve. 

2. The distance sensor as recited in Claim 1 , 

wherein the further means (3) are a yaw rate sensor, whose signal can be used for 
correcting the trajectory curvatures. 

3. The distance sensor as recited in Claim 1 or 2, 

wherein the control system (1) designed for determining a quality indicator (q_traj) of 
the trajectory from the ascertained misalignment angles of individual trajectories by 
adaptive long-term filtering. 

4. The distance sensor as recited in Claim 3, 

wherein the quality indicator (q_traj) is calculated, for example, from the correlation 
value of a regression analysis of the curvature, the number of measured points, the 
trajectory length and/or the object speed (6). 

5. The distance sensor as recited in Claim 3 or 4, 

wherein the adaptive long-term filter is a noise-optimized linear filter, preferably a 
Kalman filter. 

6. The distance sensor as recited in Claim 3 or 4, 

wherein the adaptive long-term filter is a nonlinear filter in which the weighting of the 
individual measured values results from the quality appraisal. 
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7. The distance sensor as recited in one of the preceding claims, 

wherein, in case of the positioning of the sensor (2) outside the center line (M) of the 
motor vehicle (5), the control system (1) ascertains the misalignment angle 
(alphasensor) with respect to the center line (M). 

8. The distance sensor as recited in Claim 7, 

wherein the control system (1) is designed to weight the misalignment angle either as 
a function of the weighted average values of the yaw rate sensor (3) or the 
displacement (y ra dar) of the center line (M). 

9. The distance sensor as recited in Claim 8, 

wherein the weighting takes place on the weighted average values of the two 
individual methods. 

10. The distance sensor as recited in Claim 8 or 9, 

wherein quality numbers for the misalignment angle are developed from the 
weighting factors (Gl , G2) according to the formula: 

d a ipi 1 a = Gl(q_traj)*d alphaJraj + G2(q_obj)*d alphaobj . 

where d^ is the currently valid misalignment angle from the center line (M) and 
Gl(q_traj) or G2(q obj) are weighted average values from the values of the yaw rate 
sensor or the average displacement, (and) d^ Jraj and d^ pha obi are associated angles. 

11. A speed regulator having a sensor as recited in one of the preceding claims, 
wherein the sensor (2) is mounted on the front and/or rear area of a motor vehicle (5). 
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Abstract 

The present invention proposes a distance sensor having a sensor for a motor vehicle in which 
means are provided by which misalignment angles and trajectory curvatures can be 

5 compensated for during travel not only on a straight road but also along curves. In a sensor 
(2) mounted displaced from the center line of the vehicle, an angle (alpha_sensor) is 
measured which cuts the projected center line of the motor vehicle (5) at the target object, a 
vehicle (6) driving ahead. By the additional use of a yaw rate sensor (3), curve curvatures of 
the road are also compensated for, so that angle and distance measurement can also be made 

10 along curves. 

(Figure 1) 
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COMBINED DECLARATION AND 
POWER OF ATTORNEY FOR PATENT APPLICATION 



As a below named inventor, I hereby declare that: 

My residence, post office address and citizenship are as stated below 
adjacent to my name. 

I believe I am the original, first and sole inventor (if only one name is 
listed below) or an original, first and joint inventor (if plural names are listed below) 
of the subject matter which is claimed and for which a patent is sought on the 
invention entitled DISTANCE SENSOR HAVING A COMPENSATION 
DEVICE FOR A MISALIGNMENT ANGLE IN A VEHICLE, and the 
specification of which: 

[ ] is attached hereto; 

[ ] was filed as United States Application Serial No. 
and, 

[X] was filed as PCT International Application Number 

PCT/DE00/03397, on the 27 th day of September, 2000 
[X] an English translation of which is filed herewith. 
I hereby state that I have reviewed and understand the contents of the 
above-identified specification, including the claims, as amended by any amendment 
referred to above. 

I acknowledge the duty to disclose information which is material to the 
examination of this application in accordance with Title 37, Code of Federal 
Regulations, § 1 .56(a). I hereby claim foreign priority benefits under Title 35, United 
States Code § 1 19 of any foreign application(s) for patent or inventor's certificate or 
of any PCT international applications(s) designating at least one country other than 
the United States of America listed below and have also identified below any foreign 
application(s) for patent or inventor's certificate or any PCT international 
application(s) designating at least one country other than the United States of America 
filed by me on the same subject matter having a filing date before that of the 
application(s) of which priority is claimed: 
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PRIOR FOREIGN/PCT APPLICATION(S) 

AND ANY PRIORITY CLAIMS UNDER 35 U.S.C. §119 



Country : Federal Republic of Germany 

Application No. : 1 99 52 056. 9 
Date of Filing: 28 October 1 999 

Priority Claimed 

Under 35 U.S.C. § 119 : [x] Yes [ ] No 

I hereby claim the benefit under Title 35, United States Code § 120 of any United 

States Application or PCT International Application designating the United States of 

America that is/are listed below and, insofar as the subject matter of each of the 

claims of this application is not disclosed in that/those prior application(s) in the 

manner provided by the first paragraph of Title 35, United States Code § 1 12, 1 

acknowledge the duty to disclose material information as defined in Title 37, Code of 

Federal Regulations § 1.56(a) which occurred between the filing date of the prior 

application(s) and the national or PCT international filing date of this application: 

PRIOR U.S. APPLICATIONS OR 
PCT INTERNATIONAL APPLICATIONS 
DESIGNATING THE U.S. FOR BENEFIT UNDER 35 U.S.C. § 120 

U.S. APPLICATIONS 

Number : 

Filing Date : 

PCT APPLICATIONS 
DESIGNATING THE U.S. 

PCT Number : 

PCT Filing Date : 
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I hereby appoint the following attorney (s) and/or agents to prosecute 



the above-identified application and transact all business in the Patent and Trademark 

Office connected therewith. 

(List name(s) and registration mimber(s)): 



are true and that all statements made on information and belief are believed to be true 
and further that these statements were made with the knowledge that willful false 
statements and the like so made are punishable by fine or imprisonment or both under 
Section 1001 of Title 18 of the United States Code and that such willful false 
statements may jeopardize the validity of the application or any patent issuing 
thereon. 




All correspondence should be sent to: 




Telephone No.: (212) 425-7200 
Facsimile No.: (212) 425-5288 



CUSTOMER NO. 26646 



I hereby declare that all statements made herein of my own knowledge 
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Full name of inventor Klaus WINTER 



Inventor's signature [__p^ b(^£ t ^ / 2m 

Citizenship: Federal Republic of Germany 



Residence: Richard- Wagner- Strafte 17/1 

71701 Schwieberdingen £)PX 
FederarR^pubilcof^aermany 



Post Office Address Same as above 
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Full name of inventor Hermann WINNER 



Inventor's signature 




Citizenship: Federal Republic of Germany 

Residence: Im>TeM^ , ~%e*c/ ff r- HoMer 

Federal Republic of Germany IX^ 

Post Office Address Same as above 
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Full name of inventor ,, Reiner MARCHTHALER 



tabor's signature Kfol. M^lW l** 6zMI2^ 

Citizenship: Federal Republic of Germany 

Residence: Kastanienweg 13 

7 3333 Gingen_ ftX 
Federal Republic of Germany 

Post Office Agrees Same as above 
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Full name of inventor J^ jJlIEDtKR, 




Inventor's signature Date 



Citizenship: Federal Republic of Germany 
Residence: Im Obstgarten 20 



7ngn6 TCnrnwestheim P^X 
Federal Republic of Germany 



Post Office AHHress Same as above 
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Full name of inventor Stephan LEINBAUM 

Inventor's signature j3&W^ >^£l-> Date Q%2pv A 



Citizenship: Federal Republic of Germany 



Residence: GroBmoltenstraBe 28 

J71739 Oberriexingen £)€X 
Federal Republic of Germany 



Post Office Address Same as above 
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